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ABSTRACT 


Autonomous Underwater Vehicles (AUVs) require a 
navigation system in order to conduct useful functions. This 
research was an experimental investigation of the commercial 
DiveTracker underwater acoustic navigation system used 
onboard the NPS Phoenix AUV. Tests conducted with the 
DiveTracker system proved that the system could be used 
successfully in AUV navigation while submerged and revealed 
that more precise positioning could be obtained through 
postconditioning of the DiveTracker output ranges, rather 


than prefiltering. 
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I. INTRODUCTION 
A. THE NEED FOR MINE RECONNAISSANCE 


During the Korean War a United States Navy armada of 250 
ships and 50,000 Marines were delayed in assaulting the 
Korean port of Wonsan through the failure to recognize the 
importance of mine warfare. The Amphibious Task Force 
Commander remarked “We have lost control of the seas to a 
nation without a Navy...” , [Reference 1]. The most serious 
enemy inflicted damage to U.S. Navy since World War II has 
been caused by undetected mines in the Persian Gulf. USS 
Samuel B. Roberts (FF-58), USS Tripoli (LPHG-10)and USS 
Princeton (CG-59), unknowingly steamed into Iraqi mine 
fields. During the Gulf War, USS Tripoli was the flagship of 
the Navy’s Mine Countermeasures Group and was incharge of 
reconnoitering and clearing a path through the mine fields, 
[Reference 2]. A recent Chief of Naval Operations White 
Paper has called for increased efforts in mine warfare, 


including research and development programs, [Reference 3]. 


B. AUV APPLICATION 


Mine hunting in the shallow water zone (10 to 40 feet) 
presents unique challenges to the U.S. Navy. For maximum 
flexibility the mine countermeasure efforts should be covert, 
cost effective and relatively quick, [Reference 1]. Current 
MCM efforts that involve both ships and helicopters do not 
have a covert capability and are highly susceptible to shore 
based missile batteries. Marine mammal systems and special 
forces are capable of operating covertly. However they are 
scarce resources that require extensive training pipelines, 
[Reference 4]. The marine mammals are limited to MCM efforts 


in water depths of forty feet and greater and require onsite 





handling. The Commander, Mine Warfare Command, has recently 
stated the need for development of Autonomous Ocean Network 
employing Autonomous Reconnaissance Vehicles (ARV) and Small 
Neutralizer Robots. Today, the AUV technology exists to 
engineer and deploy such mine reconnaissance vehicles capable 
of operating clandestinely in the shallow water and very 


shallow water zone. 
Cc. SCOPE OF THESIS 


One of the key engineering problems facing development 
and greater utilization of autonomous vehicles, underwater 
navigation, communications and control are high on the list. 
Underwater navigation is accomplished in submarine using 
expensive and large inertial systems. Other dead reconing 
techniques include the use of doppler sensors for speed over 
ground combined with a compass or directional gyroscope 
heading reference. Alternatively, acoustic beacons may be 
used but are expensive and usually provide position only to a 
mother ship. 

The primary focus of this thesis was to determine the 
viability of the DiveTracker system in establishing the 
lateral position of the Phoenix AUV while operating submerged 
in a salt water environment. Specific objectives were to 
determine the error associated with DiveTracker range values 
and to determine the best method of filtering the position 
data. 

Chapter II contains a discussion of acoustic navigation 
and Phoenix AUV employment concept. Chapters III and IV 
describe the DiveTracker system and Phoenix AUV in detail. 
Chapter V describes the experimental procedure completed. 
Chapter VI presents the Kalman filter used in data smoothing, 
the experimental results and data analysis. Conclusions and 


recommendations are made in Chapter VII. Pertinent computer 








files are given in Appendices A and B. Figures are presented 


at the end of each chapter as applicable. 














re 


x ie ACOUSTIC UNDERWATER NAVIGATION 


A. LIMITATIONS OF GPS/INS 


For AUV navigation the use of the Global Positioning 
System requires that the vehicle be at the surface in order 
to expose an antenna. This removes the vehicle sonar from 
the most favorable depth for sonar search. Use of an antenna 
buoy tethered to the vehicle imposes an unacceptable drag 
penalty on the vehicle. An inertial navigation system (INS) 
adds weight, size, and power requirement penalties. Small 
inertial systems are susceptible to position and heading 
drift. As more accurate inertial system are used the cost, 


| Size and power requirements increase rapidly. Current 





acoustic tracking systems offer a low power, small sized 
package suitable for underwater vehicle navigation. One such 
system is the DiveTracker system manufactured by Desert Star 
Systems. This navigation system is small in size with low 
power requirements and provided acoustic navigation to the 
submerged Phoenix AUV. DiveTracker uses fixed acoustic 
transducers to establish a reference baseline for navigation, 


and therefore minimized drift errors. 


B. ACOUSTIC BASELINE NAVIGATION 


An acoustic navigation system is one in which a vehicle 
determines its location by measuring the range to a fixed 
acoustic array. The advantage of such a system are minimal 
hardware installation, minimal use of vehicle power, small 
size, and the incorporation of acoustic modem for data 
transmission. The system installed on the Phoenix AUV uses 
the DiveTracker system developed by Desert Star. 

In acoustic navigation systems, range is not measured 


directly. The time difference between transmitted and 








received sonar pulses or ‘pings’ are converted to range. To 
determine the range from a fixed array element the vehicle 
measures the time difference between a transmitted ping and 
received reply ping. The range equation is: 
R= t eosived = Caen | (1) 
Cc 


Unlike hyperbolic systems such as Loran or Omega radio 
navigation systems, the DiveTracker system measures actual 
received time not time difference between two or more array 
elements. The advantage of such a system is that an exact 
global time standard is not necessary. Only the time 
difference between pings must be measured accurately. The 
range give a coordinate corresponding to a arc of constant 
range from corresponding the array element. The crossing to 
two or more range arcs gives the vehicle location in an 
cartesian coordinate system. The coordinate system used by 
the Phoenix vehicle is a right handed system defined as 
follows: 

X-ax1ls points North 
Y-axis points East 


Z-axis points Down 


The Phoenix AUV system has been developed to date using 
a two element array which will be referred to as a “short 
baseline system”, (SBL). The two element array yields two X 
coordinate solution values and give a true and ‘ghost’ 
position. Therefore it is necessary to know on which side of 
the array baseline the vehicle is operating.. A three 
element array would provide a third range arc and give the 
system a single solution automatically, but with added 


expense and complexity. 

















Cc. RANGE TO CARTESIAN COORDINATE CONVERSION 


In the established coordinate system (see Figure 1), one 
array transducer is located at the origin, and the second at 


a known location (X),Y,)). X and Y coordinates are determined 


from using the following equations: 


F, (X,Y,Z,R1) =X°+Y'+(Z-Z,,)’-R1’=0 (2) 
F,(X,Y,Z,R1) =(X—Xq,)?+(Y—Yo.)"+ (Z—Zpy)?—R27=0 (3) 
where 
Z),= Surface Station 1 Depth 
X= Surface Station 2 X coordinate 
Yo. = Surface Station 2 Y coordinate 
Z2= Surface Station 2 Depth 


The Z coordinate is given by vehicle depth as measured from 





the onboard depth sensor. These equations then can be solved 
either analytically or numerically and are computed to yield 
current position (X,Y,Z). For operations with the 
transducers and vehicle near the same horizontal plane the 
problem reduces from a spherical solution to a cylindrical 
solution. 

The accuracy of the cylindrical solution differs from 
the hyperbolic navigation. Solution error sensitivity is 
studied by linearizing equations (2) and (3), and defining 


the Jacobian of the range equations as F(y,x) as: 





OF, OF, 

Oy Ox 2y 2x (4) 
a OF, OF, iene or 

Oy Ox 


The determinate of the Jacobian is zero along the baseline. A 
range measurement shortfall along the baseline results in no 


possible solution. Therefore operation along the baseline 








should be avoided. 

The precision of X and Y positions is a function of 
crossing angle of the tangents to the respective range arcs. 
For a given range variance, the most accurate position occurs 
when tangents to the range arc cross at 90 degrees. Precision 
fall off as the angle between the tangents decreases. 

Changes in X and Y position as a function of angle and change 


in range: 








Precision can be expressed as the angle between the 
received range arc tangents. Figure 2 shows the geometry of 
the position uncertainties. Figures 3 and 4 show how the 
coordinate transformation affects the X and Y uncertainty for 
a set range uncertainty for crossing angles between 0 and 90 
degrees. For all cases one coordinate position error is 
reduced by a factor between 1 and 0.707 while for the other 
coordinate the error is increased by a factor of 0.0707 to 
infinity. At 30 degrees crossing angle the magnification 
factor is 3.5 and reaches the limit of acceptability. This 
locus of 30 degree crossing normalized for a baseline length 
of unity is shown in Figure 5. At an angle of 30 degrees the 
X position deviation is reduced by a factor of 0.95, but the 


Y position deviation is increased by a factor of 3.5. 








Range R1 , Range R2 





Figure 1 Coordinate System 








Figure 2 Position Uncertainty 
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Iii. DIVETRACKER SYSTEM 


The DiveTracker system is a commercially produced system 
for underwater navigation, communications, and diving 
Support. It consists of both hardware and software 
subsystems. It is produced by Desert Star Systems for use by 
divers and underwater vehicles and represents a low cost, but 
simple solution for short range shallow water navigation 
where putting antenna through the surface is not desirable. 


Major system components are shown in Figure 6. 
A. DIVETRACKER HARDWARE 


The Divetracker hardware is a consists of sonar 
transducers, mobile unit, ‘surface’ station, and connecting 
cabling. The system in available in various configurations 
depending upon display and navigation requirements. 
Divetracker Model DT1-MOD mobile unit, a single DT1-D-TDCR-40 
transducer, and connecting cabling are used in the Phoenix 
AUV to provide navigation information to the AUV. A 
Divetracker Model DT1-DRY, two DT1-D-TDCR-40 transducers and 
connecting cabling are used for the surface station. For 
testing of the system without the Phoenix AUV a Divetracker 
Model DT1-D-S, a single DT1-D-TDCR-40 transducer, connecting 
cabling, and a Zenith 248 portable computer are used to 
Simulate the Phoenix AUV. DiveTracker hardware is shown in 


Figure 6. 

ac Be DiveTracker Model DT1-MOD 

The Divetracker Model DT1-MOD used in the Phoenix AUV is 
an electronics module mounted on an aluminum support 


structure. The chassis measures 6 inch by 3 inch by 1.75 


inches The unit incorporates a MC68HC11 microprocessor 
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operating at 1MHz, 256 Kbyte of permanent flash memory, 24 
Kbyte of EPROM (electronically programmable read only memory) 
for the SmartDive software, 256 Kbyte of flash memory for 
DiveCode storage, 256 Kbyte of RAM (read: only memory) for 
data storage. Data input/output is through a RS232 serial 
data link to the execution level program. Power requirements 
are 840 mWatts. A five pin connector provides link to the 
external sonar transducer. The DT1-MOD receives the signal 
from the transducer, and using the SmartDive software 
computes the ranges and provides the data to the Gespac 
computer in the Phoenix AUV. The DT1-MOD also handles the 
timing sequence for the sonar replies from the Phoenix AUV. 


[Reference 5 p. 4-22] 
2. DiveTracker Model DT1-DRY 


Divetracker Model DT1-DRY used for the surface station 
is identical to DT1-MOD with the electronics enclosed ina 
splash proof polycarbonate case measuring 6.75 inches by 5.25 
inches by 2.2 inches. The unit weighs 22 ounces An 
external power supply of 9 volts DC at 1 Amp peak is 
required. Four five pin connectors provide the links the 
sonar transducers, serial communications to a personal 
computer, and power input connection. The DT1-DRY provides 
the same functions for the surface station as the DT1-MOD 
does for the Phoenix AUV with the difference in that it is 
connected to two transducers vice as single transducer for 
the DT1-MOD. [Reference 1 p. 5-18] 


3 DiveTracker Model DT1-D-S 
Divetracker Model DT1-D-S is enclosed in a water tight 


hard anodized aluminum chassis measuring 8.5 inches by 3.5 


inches by 2.16 inches. The unit has the microprocessor and 
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memory of the DT1-MOD and incorporates a 64 by 128 pixel 
liquid crystal display with backlighting and 16 key solid 
state keyboard. A five pin connector provides the link to 
the sonar transducer. A second five pin connector provides 
the serial link to a personal computer and provides for the 
battery charging connection. The DT1-D-S was used to simulate 
the Phoenix AUV system. The DT1-D-S connected to a single 
transducer and laptop computer acted as a mobile station and 
provided received ranges to the laptop. [Reference 1 p. 2- 
34] 


4. DT1-D-TDCR-40 


The DT1-D-TDCR-40 is the external sonar transducer used 
by the divetracker system. The sonar operates from 33 KHz to 
41 KHz. Horizontal beamwidth is 360 degrees. Vertical 
beamwidth is 88 degrees. Transmit sound pressure level is a 
maximum of 169 dB reference to 1 microPa at 1 meter. The 
transducer has an omni-directional pattern in the horizontal 
plane (perpendicular to cable mounting axis. The transducer 
can be mounted such that the cable is either pointing up or 
pointing down. Three transducers were used for the acoustic 
navigation system. Two transducers connected to the DT1-DRY 
formed the short baseline, and one transducer connected to 
either the DT1-MOD in the Phoenix AUV or the DT1-D-S acted as 
the mobile station. [Reference 1 pp. 1-11 through 1-13] 


B. DIVETRACKER SOFTWARE 


The Divetracker system uses three C language based 
programs (SmartDive, DiveBase, and DiveTerm) to implement the 
navigation and communication features of the system. 
SmartDive is the application software used by each 


DiveTracker for the navigation and communication functions. 
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DTOS is the operating system used by the DiveTracker 
stations. SmartDive program runs under the DTOS operating 
system on the DiveTracker stations. SmartDive versions 1.2.1 
and 1.2.3 were used during testing. DiveBase is an MS-DOS 
program for the surface station personal computer and the 
mobile unit. DiveTerm is a MS-DOS based utility program to 
download application software to the DiveTracker stations. 
Under the DiveBase software, several programmable features 
are controlled using the DiveBase parameters file. | 
[Reference 1 p.1-2] 


Uf 4. DIVEBASE PARAMETER FILE 


The DiveBase parameter file, divebase.par, controls the 
mission specific setting of the DiveTracker system. The 
sonar navigation protocols, sonar and communications 
parameters are configured under the divebase.par file. This 
configuration file is shown in Appendix A. Parameters of 
interest to this study were transmit power level, receive 
gain sensitivity receive threshold level, rest time between 


pulses, and baseline length. 
22 DiveTracker Navigation Protocol 


The DiveTracker system uses a continual pinging system 
to determine range from the baseline transducers. Range is 
calculated from the time difference between sent and received 
sonar pulses or pings in a way that both the mobile unit and 
the surface station retain information concerning the 
position of the mobile unit. The transducer pinging schedule 


1s show in Table 1. 
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1 Surface Station 
transducer 1 pings. 
| 
S 
a 
oe 
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Mobile unit receives 
ping and replies. 


Surface Station Surface Station 
transducer 1 calculates range from 
recelves ping and Mobile Unit to 
replies. transducer 1 based on 
time 3-1. 


























Mobile Unit calculates 
range from Diver to 
transducer 1 based on 
time 4-2. (Time index 1 
through 4 constitute 
one pinging cycle.) 


Mobile Unit receives 
ping and replies. 
























Surface Station 
calculates range from 
Diver to transducer 2 
based on time 5-3. 


Surface Station 
transducer 2 
receives ping and 
Surface Station 
transducer 1 replies 










Mobile Unit calculates 
range from Diver to 

transducer 2 based on 
time 6-4. 


Mobile Unit receives 
ping and replies. 






Table 1 DiveTracker Pinging Protocol 


DiveTracker DT1-MOD range calculations: 


R j= time 4 — Time 2 (6) 
aeeeer Speed of Sound 
Time 6 — Time 4 
Range 2 = “Speed of Sound ~ Range 1 — Baseline Length (7) 


Figure 7 shows the layout of the system in use. 
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Cc. DIVETRACKER IMPLEMETATION 


For experiments in the MBARI Moss Landing Basin the 


following parameters were used: 


Baseline length various - 6.1 to 14.6 meters 
(20 to 48 feet) 

Transmit power Maximum of 60 Watts 

Pulse length 4000 microseconds 

Detection threshold 1 

Transducer turnaround O.1 seconds 

Maximum range 1828 meters (6000 feet) 


The complete configuration file is shown in Appendix A. 
D. DIVETRACKER LIMITATIONS 


DiveTracker SmartDive software assumes a speed of sound 
in water of 1494 meters per second corresponding to a sea 
water temperature of 11°C. Operations in sea water of 
Significantly different temperature will: introduce a bias 
error in the ranges provided by DiveTracker. The Divetracker 
system is suitable for underwater navigation of AUV’s in open 
ocean scenarios. The system has an advertised range of 600 
meters (2000 feet) based on transmit power at 40 kHz. 

Testing in the Moss Landing Basin demonstrated a range limit 
of approximately 150 meters. This reduced performance may be 
caused by the shallow soundings (less than 20 feet)and the 
soft mud bottom conditions of the Moss Landing channel. As 
implemented both shore transducers must be connected to the 
surface station by cables, limiting the maximum baseline 
length. As the size of the area of most accurate navigation 
is a function of baseline length, this restriction on 


baseline length limits the area of employment of DiveTracker. 
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Under current ranging protocol the R2 range calculation adds 
any Rl range error and baseline error to the R2 range error. 


The R2 range will have a greater uncertainty than the R1 
range. 
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Figure 6 DiveTracker System 
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40KHz Transducer 
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Figure 7 DiveTracker Ranging 
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IV. PHOENIX AUTONOMOUS UNDERWATER VEHICLE 


A. PHYSICAL DESCRIPTION 


The Phoenix Vehicle, shown in Figures 8 and 9, is an 
autonomous underwater vehicle designed for research in 
intelligent control. The vehicle incorporates TRITECH ST1000 
and ST725 high frequency sonars to provide data about the 
environment. Motion behavior at slow speed is controlled by 
the four cross body thrusters and two propulsion thrusters. 
When moving at speed, eight control fins and the two 
propulsion thrusters provide control. The control system is 
implemented in hardware using two networked processors. All 
execution level software operates under the OS-9 operating 
system on a GESPAC M68030 processor in a separate card cage 
in the vehicle. Connected in the same card cage is an 
ethernet card and array of real time interfacing devices for 
communications to sensors and actuators. A Sun Voyager 
computer is located in the Phoenix run the tactical level 
software written in “C” code and the strategic level software 
written in Prolog. The Divetracker Model DT1-MOD output is 


connected to the Gespac processor via a serial connection. 
B. SOFTWARE DESCRIPTION 


The Phoenix AUV control software operates on three 
levels. Strategic level software uses Prolog rules to 
specify the mission to be conducted. The Tactical level 
software links with the Strategic software and sends the 
vehicle the primitive commands necessary for vehicle 
operation. At the Tactical level separate processes operate 
in the Sun Voyager computer simultaneously under the paradigm 
of a U. S. Navy submarine command structure with an Officer 


of the Deck process, Navigator process, Sonar process, and 
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Engineer process. The Execution level software is composed 
of the software drivers necessary for the vehicle hardware 
operation. Execution level software reads the DiveTracker 
Model DT1-MOD output and passes the data up to the Tactical 
level for evaluation. The Execution level software performs 
all necessary control functions such as autoheading, 
autodepth, autospeed, and hover commands as requested by 


Tactical level code blocks. 
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Figure 9 Phoenix AUV Internal View 
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V. EXPERIMENTAL PROCEDURE 


DiveTracker range data were obtained using both the 
stand alone Divetracker Model DT1-D-S Mobile Unit and Phoenix 
AUV in conjunction with the Divetracker Model DT1-DRY surface 
station. Data runs were obtained in the Monterey Bay 
Aquarium Research Institute (MBARI) boat basin at Moss 
Landing, California. Testing without the Phoenix AUV was 
conducted to validate the DiveTracker system and determine 
the optimal software and hardware configurations for later 
testing with the Phoenix AUV. Testing with the Phoenix AUV 
was conducted to validate vehicle control and use of the 
position data during an autonomous mission using the 


DiveTracker system as the primary navigation system. 
A. TESTING WITHOUT PHOENIX AUV 


Testing was conducted at the MBARI basin using the 
DiveTracker DT1-DRY surface station and Divetracker Model 
DT1-D-S Mobile Unit. The surface station consisted of the 
DiveTracker DT1-DRY connected to a Zenith desktop personal 
computer and two DT1-D-TDCR-40 transducer baseline which was 
placed at various locations around the basin. The mobile unit 
consisted of the Divetracker Model DT1-D-S connected to a 
zenith 286 laptop computer and single DT1-D-TDCR-40 
transducer to simulated the Phoenix AUV. Ranges were 
recorded with the mobile unit and transducer stationary and 
moving in a small rowboat. Raw ranges were recorded on 
floppy disk by a Zenith 286 laptop computer. No time data 
for the raw ranges were available for this testing 
configuration. Divebase configuration file parameters such 
as transmit power level and receive sensitivity threshold 
were varied to determine optimal setting for future 


operations in the MBARI basin with the Phoenix AUV. 
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B. TESTING WITH THE PHOENIX AUV 


In water testing with the Phoenix AUV was conducted from 
January 26 to February 2, 1996 at the MBARTI basin. The same 
surface station as used in the simulated testing was used. 
Nineteen separate runs were conducted using various planned 
missions. For all runs except 2-02-1, the surface station 
baseline arrangement of along the southern edge of the basin 
was used as shown in Figure 10. For run 2-02-1, the baseline 
was placed along the pier at the north end of the west side 
of the basin. Inside the AUV, DiveTracker model DT1-MOD 
outputed range data to the Gespac computer. Range data was 
passed to and stored by the Voyager computer as part of the 
AUV state vector telemetry on the Phoenix AUV and downloaded 
post mission via the “thin wire” Ethernet connection. 

Testing runs are identified using the convention of 
Month-Day-Daily Run Number. For all runs the Phoenix AUV was 
manually placed at the starting point. The Phoenix AUV was 
submerged sufficiently to wet the DiveTracker transducer and 
establish track with the surface station. In order to 
initialize the Phoenix AUV for each mission the vehicle was 
broached out of the water in order to receive GPS and DGPS 
Signals via antennae mounted on top of the Phoenix AUV. This 
brought the DiveTracker transducer out of the water, and 
interrupted the pinging sequence on the DiveTracker system. 
During testing on January 29 and January 30, this initial 
broach of the vehicle caused the surface station to go into a 
sleep mode. Once the vehicle submerged to under 2 feet, 
DiveTracker pinging sequence was not re-established in 
sufficient time to prevent mission abort on loss of 
DiveTracker signal. This problem was overcome by increasing 
the loss of DiveTracker abort from 10 seconds to 45 seconds 


and by upgrading the SmartDive program to version 1.2.3. For 
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missions on January 31 and February 1, no DiveTracker related 
mission aborts occurred. For the single mission attempt on 
February 2, the Phoenix AUV was started adjacent to the 
baseline. The Phoenix AUV navigator program incorrectly 
solved for the X axis solution on the opposite side of the 


baseline than the vehicle actually was. 


Description of significant test runs: 
Run 1-31-3 
This mission was started 16m north of transducer 1 
on a heading of north. The mission was designed to test the 
Phoenix ability to hover at a designated point. The vehicle 
operated for approximately 500 seconds. 
Run 2-01-2 
This mission was started 16m north of transducer 1 
on a heading of north. This mission was designed to test 
calibration of the forward motion speed model. The vehicle 
initialized at the starting location, transitted at maximum 
speed to a point 28m north of transducer 1 and hovered for 
approximately 200 seconds. 
Run. 2-01-7 
This mission was started 16m north of transducer 1 
on a heading toward transducer 1. This mission was designed 
to be a complete test of the Phoenix AUV. Unfortunately 107 
seconds into the mission the Voyager computer battery voltage 
dropped low causing the strategic and tactical programs to 
fail. 
Run 02-01-2 © 
This mission was started 1m north of the baseline 
midpoint. The mission was designed to transit north and 
search for the mine-like object. However the Navigator 
software module incorrectly calculated that the Phoenix AUV 
was on the south side of the baseline. Although the 


DiveTracker correctly tracked the vehicle, the incorrect 
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Navigator solution generated false control signals. The 

mission was aborted after approximately 10m travel. 
Following completion of testing, all telemetry data was 

transferred to the Naval Postgraduate School Mechanical 


Engineering computer laboratory for analysis. 
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VI. RESULTS 


The mission runs were analyzed to determine the 
viability of DiveTracker in providing precise navigation data 
and to determine the best method of filtering the data to 
improve the precision. Without a secondary position 
reference providing information of greater precision than 
DiveTracker, no absolute reference position was available for 
the Moss Landing data. Therefore analysis relies on 
comparing the filtered data to raw data, and accessing the 
variability seen in the raw signals. The first step in data 
analysis was separating out those state vector values for 
which a DiveTracker range was received using Matlab. Then 
using Matlab, two methods of filtering the navigation data 
were analyzed. First, the ranges were smoothed using a 
Kalman filter and translated into X and Y coordinates for 
analysis and plotting. Alternatively, the ranges were first 
translated into X and Y and then smoothed using the Kalman 


filter then analyzed and plotted. 
A. KALMAN FILTER 


If a process is affected by random white noise in both 
the system and the output measurement, then Kalman filtering 
techniques offer a method of reducing the output 
fluctuations. The Kalman filter used was based on the 
discrete time filter used by the Phoenix AUV sonar process. 
The filter uses a three state model of position, velocity and 
time. Output of the model is position. System noise is 
assumed to variation in the acceleration of the model. 
Measurement noise is added onto the output of the process. 
The Kalman filter is a recursive method in that it improves 
the estimate of a state value based on the previous value. 


Assumptions of the Kalman filter are the both the system 
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noise and measurement noise are random with a mean value of 
zero and that the noise is constant for each time step. For 
each update cycle the measured state is compared with prior 
estimates and are weighted by Kalman gains to obtain updated 


state estimates for position, velocity and acceleration. 


The continuous system model is: 


x=Ax+Bw, 
(8) 
y=Cx+ w, 
where 
X = state vector of positon, velocity, acceleration 
x = time derivative of state vector 
010 0 
A= |9 01] B=/0} c=[1 0 0] 
000 I 
W,= system noise 
W.= measurement noise 
The discrete time system model is: 
X,,,= ®x,+Tw 
k+1 k 1k 9 ) 


y,=Cx, + Ww, 


where 
Adt 
@M=e 


r=(I-e““)A'B 
dt= time step 
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The formula for the Kalman filter is derived by 
optimizing the assumed form of the linear estimator. The 


state estimate at time k+l based on time k data is: 
Xai p= OR, + Tw, (10) 


The use of the subscript k+1/k defines a value at the k+1 
time step based on the k (previous) time step. The k+1/k+1 
defines a value at the k+1 time step based on updated 
information at the k+l time step. The covariance of the 
estimate of the state is given by: 


-_ = | 
PHE AK incai Xai ske } ce) 


In matrix form: 


0.x On. G-, 
2 2 2 
P= OV. Ov, Ova (12 ) 
2 2 2 
Ox On 0. 
where 


6, = Standard deviation of positon 
O,= Standard deviation of velocity 


O,= Standard deviation of acceleraton 


The error covariance before update is calculated by: 


Pysix= OP, +1Q (13) 


The optimal gain is calculated by: 


Pa 
G. 41> T (14) 
CP, sete 5 R 
where 


jf 








Q = w, System noise 


2 ; 
R =w, Measurement noise 


The updated covariance matrix is: 
Pcie = | Oa © [Pan (T>) 


The updated state estimation is: 


R41 = PX, + G, [y,— CR, | | (16) 
The term [y,,,-Ck,] represents the ‘innovation’ for each time 


step, [Reference 6]. While most Kalman filters operate at a 
fixed update rate, the DiveTracker system operates 
asynchronously based on time of reception of the sonar pings. 
This variable time step requires recalculation of the 
conversion of state space models from continuous to discrete 
time at every cycle. Equations (13) through (16) are used in 


the Kalman filter program given in Appendix B. 


B. NOISE CHARACTERISTIC 


Kalman filtering assumes that the noise is random and 
follows a Gaussian distribution. For the most significant 
mission runs, the filtered data was compared to the raw data. 
Figures 11 through 19 show the histograms of difference 
between estimated and measured data which represents the 
innovation with Gaussian overlay. While the differences are 
not perfectly Gaussian, the general trend follows the 
Gaussian distribution and allows for use of Kalman filtering 
in noise reduction. Due to the sonar pinging protocol used 
by the DiveTracker system error in the Rl range measurement 
are added to the R2 range measurement errors. As shown in 
Table 2, the R2 range has approximately twice the standard 


deviations of R1 range. 
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Cc. FILTER TUNING 


In order to tune the filter to smooth out data values 
for sensory noise and process noise were varied. Three 
values of system noise to measurement noise ratio analyzed 
for the filter were 1:1000, 1:100,000, and 1:10,000,000. For 
the analysis method of filtering ranges then translating into 
position the standard deviation values for R1 and R2 ranges 
are given in Table 2. For the method of translating then 
filtering, the standard deviation values for X and Y 
positions are given in Table 3. Without a reference position 
for each run the deviations are between the estimated and 
measured data. The objective was to smooth out the Phoenix 
track without excessively lagging behind the position. 
Therefore it was judged that the medium speed filter 
performed the best. The filtered and raw range and position 


plots are shown in Figures 20 through 28. 
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Run Filter R Sigma 
Speed | value R2 (m) 


1291 


13 LL 


2=01=2 


22-0241 


1 0.7248 L32067 





Table 2 Prefiltering Range Deviations 
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Medium 


270251 





Table 3 Postfiltering Position Deviations 
D. FILTER INITIALIZATION 


Having the DiveTracker transducer mounted on the upper 
surface on the Phoenix vehicle prevented reception of range 
information while the vehicle was initializing at the surface 
and resulted in filter transients greater than expected. 

Run 2-01-6 (Figure 22) and Run 2-02-1 (Figure 24) show large 
filter transients than the other runs. This is due to the 


4] 








vehicle stating motion before the optimal gains have be 
calculated and the filter has locked on. 

For Run 2-01-2 the Phoenix vehicle hovered at the 
initial submergence point and the filter transients have time 
to subside prior to vehicle motion. In both prefiltering, 
(Figure 21), and postfiltering, (Figure 25), analysis ranges 
and position do not show large transients from the unfiltered 
data. 


E. VALIDATION OF OPERATING AREA 


Figure 29 shows the positions for the runs analyzed with 
loci of 30 degree crossing tangents. Operation at a distance 
greater than 1.4 times the baseline shows larger variation in 


the Y position as predicted. 
F. COMPARISON OF PREFILTERING AND POSTFILTERING 


Comparing the prefiltered positions and postfiltered 
positions for each run shows that postfiltering yields a 
reduction in radial deviation in four of five analyzed runs. 
This demonstrates that the amplification of positional error 
caused by translating to X-Y coordinates is more than offset 
through the reduction provided by post-processing through the 
Kalman filter. When range data is filtered first any 
remaining deviations are amplified. Figures 30 through 34 
compare the prefiltered and postfiltered difference plots. 
Prefiltering and postfiltering standard deviations as shown 
in Table 4. Direct comparison of the radial error for each 
filtering method is not appropriate in that it does not 
account for the amplification of error as a function of the 
angle between the range arc tangents. However, even without 
this magnification factor the postfilering analysis shows a 


reduced standard deviation compared to the prefiltered 
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analysis. 


Prefiltere Radial Postfiltered Radial 
dad Ranges Standard Ranges Standard 
Deviation Deviations 


1-31-3 = O= 0.2855 O= 0.1973 
ZA 047 : O= 0.2958 : O= 0.3619 


2-01-6 O_.= 0. O= 0.3419 O= 0.1912 
2=01-7 = 0. O= 0.7536 ; O= 0.2375 
2-02-1 - Q, O= 0.3657 





Average O= 0.4085 O= 0.2637 
Deviation 
Table 4 Comparison of Prefiltering and Postfiltering 
Deviations 


H. FILTER VELOCITY OUTPUT 


The Phoenix AUV is equipped with a longitudinal speed 
sensor termed the “speed wheel”. For longitudinal speeds 
greater than 0.1 meter per second, this sensor provides input 
to the vehicles dead reconing process. The DiveTracker 
Filter output provides a method of calibrating the gains on 
the speed wheel in order to improve the dead reconing 
estimate. For runs headed directly at or away from station 1 
transducer, the X velocity was compared to the Phoenix AUV 
speed wheel output. Figures 36 and 37 show Run 2-01-7 and 


Run 2-01-7 where the vehicle operated at speed greater than 
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0.1 meters/second. The Kalman filter X velocity correlates 


well with the speed wheel data. One of the benefits obtained 
through the use of the Kalman filter is the estimation of 


velocity as well as position. 
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Histogram of Difference in R1 Filtered and Raw with Gaussian Overlay 
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Figure 11 Run 1-31-3 Range Histogram 
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Histogram of Difference in R1 Filtered and Raw with Gaussian Overlay 


N 
on 


rh 


ty Bandwidth (% / meters) 
OT 


o 
on 





Probabili 
1 


15 1. 05  _0 0.5 1 15. 2 
Difference from Filtered Path (meters) 


Histogram of Difference in R2 Filtered and Raw with Gaussian Overlay 





Figure 12 Run 2-01-2 Range Histograms 
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Histogram of Difference in R1 Filtered and Raw with Gaussian Overlay 
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Figure 13 Run 2-01-6 Range Histograms 
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Histogram of Difference in R1 Filtered and Raw with Gaussian Overlay 
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Figure 14 Run 2-01-7 Range Histograms 
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Histogram of Difference in R1 Filtered and Raw with Gaussian Overlay 
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Figure 15 Run 2-02-1 Range Histograms 
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Figure 16 Run 2-01-2 Position Histograms 
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Histogram of Difference in X Postfiltered and Raw with Gaussian Overlay 
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Figure 17 Run 2-01-6 Position Histogram 
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Histogram of Difference in X Postfiltered and Raw with Gaussian Overlay 
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Figure 18 Run 2-01-7 Position 
Histograms 
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Histogram of Difference in X Postfiltered and Raw with Gaussian Overlay 
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Figure 19 Run 2-02-1 Position Histograms 
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Figure 20 Run 1-31-3 Filtered and Raw Ranges 
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Figure 21 Run 2-01-2 Filtered and Raw Ranges 
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Figure 22 Run 2-01-6 Filtered and Raw Ranges 
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Figure 23 Run 2-01-7 Filtered and Raw Ranges 


57 











Prefiltered R1 


Range (Meters) 


—— Filtered 


100 . 120 140 
Time (Seconds) 


Prefiltered R2 


120 140 
Time (Seconds) 





Figure 24 Run 2-02-1 Filtered Range vs Raw Range 
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Figure 25 Run 2-01-2 Filtered and Raw Positions 
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Figure 26 Run 2-01-6 Filtered and Raw Positions 
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Figure 27 Run 2-01-7 Filtered and Raw Positions 
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Figure 28 Run 2-02-1 Filtered and Raw Positions 
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Figure 29 Normalized Post-Filtered Positions w/ 30° 
Tangent Loci 
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Figure 30 Run 1-31-3 Prefiltered and Postfiltered 
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Figure 31 Run 2-01-2 Prefiltered and Postfiltered 
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Figure 32 Run 2-01-6 Prefiltered and Postfiltered 
Position Difference 
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Figure 33 Run 2-01-7 Prefiltered and Postfiltered 
Position Difference 
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Figure 34 Run 2-02-1 Prefiltered and Postfiltered 
Position Difference 
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Run 2-01-6 Filter Velocity vs Speed Wheel Sensor 


— 
x2) 
Cc 
Oo 
oO 
@ 
Ww) 
ee 
2] 
_ 
® 
— 
® 
= 
oe” 
> 
= 
© 
Re) 
® 
> 


120 160 


140 
_ Time (Seconds) 





Figure 35 Run 2-01-6 Filtered X Velocity vs Speed Wheel 
sensed Velocity 
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Run 2-01-7 Filter Velocity vs Speed Wheel Sensor 
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Figure 36 Run 2-01-7 Filtered X Velocity vs Speed Wheel 
Sensed Velocity 
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VII. CONCLUSIONS AND RECOMMENDATIONS 


A. CONCLUSIONS 


It has been clearly demonstrated that the DiveTracker 
system can be integrated with the Phoenix AUV for precise 
lateral positions. Raw range data should be translated into 
X and Y coordinates, then processed through a Kalman filter 
(postfiltering). The alternate method of filtering raw ranges 
first then converting into X and Y coordinates (prefiltering) 


results in amplification of Y position error. 
B. RECOMMENDATIONS 


It is recommended that the Phoenix AUV navigation 
process incorporate postfiltering of the X and Y position 
data to ensure precise lateral position. 

Testing with a position reference available should be 
conducted to determine the optimal filter tuning and to 
determine if a constant gain observer could be used to 
condition DiveTracker navigation output. 

Longer range testing of the Phoenix AUV should be 
conducted to determine if the DiveTracker errors are constant 
values or are the errors a function of range. 

DiveTracker transducer should be remounted on the bottom 
of the Phoenix vehicle to allow for filter transients to 
subside during vehicle initialization. 

Additional runs of extended time at speeds should be 
conducted to further correlate longitudinal speed sensor data 
with DiveTracker filter velocity to better set the speed 


sensor gain. 
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APPENDIX A: DIVEBASE.PAR 


/* 

* DiveBase Default Mission Parameter File 

* 

* This file defines DiveBase operational parameters when 
operating in 

* real-time mode or in replay mode when no mission specific 
parameter file 

* is available. 

* 

* Each command must be preceded by the 'at' symbol and ends 
at the end of 

* the line. (We can't print the '‘at' symbol here, otherwise 
what follows 
would be interpreted as a command). 


+ 


* 

* Author: Marco Flagg 

* Date: April 30, 1995 

* 

* (C) 1994, Desert Star Systems 
* 

ae | 

j* 


* Station ID list. 

* This list defines valid station ID codes and associates 
them with a 

* station symbol and name. The station symbol is used to 
identify a 

* station on the dive site display. The station name is 
used for 

* identification in the various DiveBase data windows. 

* All stations must use the same station ID list to obtain 
meaningful 

* communication. 

* 

* Command format: A<station ID>:<station symbol> <station 
name> 


* where: 7 

* <station ID>: 00..49 

* <station symbol>: Up to three characters 
* <station name>: Up to nine characters 
* 

| 


@A00:SO SURFACE-0 
@A05:DO PHOENIX 


/* 
* Maximum AUV range (feet) 
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ars 


@R: 1000 

/* 

* Maximum baseline length (feet) 

ny 

@L: 100 

/* 
* Communication speed: 

* 1. Speed: 
* 0: 3.6 nibbles/sec (14.2 baud) 
* 1: 8.9 nibbles/sec (35.7 baud) 
* 2: 17.9 nibbles/sec (71.4 baud) 
* 3: 35.7 nibbles/sec (142.8 baud) 


* 2. Receive<->Transmit Turn-around 'quiet' period: 0 - 
999999 microseconds 


mide 
@S:1 125000 
/* 
* Data exchange parameters: 
* 1. Receiver gain: 0 (least sensitive) - 3 (most sensitive) 
* 2. Detection threshold: 0 (most sensitive) - 127 (least 
sensitive) 
* 3. Transmit power: 0 (least power) - 127 (most power) 
* 42, Pulse length: 0 - 9999 microsecond 
* / . 


@X: 2 16 127 4000 


/* 

* Distance measurement offset compensation (inch) 

* The indicated value is subtracted from any distance 
measurement 

“7 


QC: 36 


/* 

* Serial data transmission by diver or ROV/AUV station: 

* 1. Transmit 'raw' position data via serial link: 1=YES, 
O=NO 

* 2. Transmit X-Y-Depth position data via serial link: 
1=YES, O=NO 

* 3. Transmit message data via serial link: 1=YES, O=NO 
@Z: 101 


/* 
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* Station function: 
* QO: Diver station 
* 1: Surface station 
* 2: Remote stations 
x 7 

@F:0 

/* 


* Station ID: 

* Surface station: 0 

* Remote stations: 0-3 
* Diver Stations: 0-9 
* 


/ 

@I:0 

| 

* Network type & navigation protocol: 

* 1. Network type: 

* O: Single transducer surface station only 

* 1: Dual transducer surface station 

i 2: Single transducer surface station & 1 remote station 

* 3: Single transducer surface station & 2 remote 
stations . 

= 4: Single transducer surface station & 3 remote 
stations 

- 5: Single transducer surface station & 4 remote 
stations 


* 2. Address mode: 


- O: One diver station only (ping inquiry) 
m 1: More than one diver station (address code inquiry) 
* 3. Diver telemetry: 
- 0: Diver station sends no telemetry 
= 1: Diver station sends 2-channel telemetry (depth & 
alr) 
* A, Navigation data availability: 
i QO: Navigation data is available to surface station only 
> 1: Navigation data is available to surface and diver 
stations 
i | 
@N:1 001 
/* 
* Number of divers to be inquired: 0-9 
£7 
@Q#:1 
/* 


* Remote station locations (stations 0-3): 
* 1. Range (ft) 
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* 2. Bearing (degrees) 
* 3. Depth: (£t) 
* 


* note: Set all parameters to 0 for auto-survey 


/* 

* Operation side of baseline (used in network types 1 & 2): 
* 0: right 

© A LeLe 

* 

a | 
@b:1 


/* 
* Surface station transducer depth (feet) 
4 


@d:0 


END 
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APPENDIX B: KALMAN FILTER 


function [xk]=highfilterl (in,Q,R,OL) 

Matlab script to function as a Kalman Filter for 
Range or Position information 
Based on kalman filter provided by Dr. A. Healey 
3 order model for relative motion 
xdot = Ax + BO 


y= Cx + R 

Variables: 

in = Input matrix of Time vector and Range or 
osition % Vector 

t = Time vector 

y = Range or Position vector 

A,B = Continuous Plant Model 


xk = estimate of state vector 
phi, gam = Discrete Plant Model 


QO = system noise variance 
R= measurement noise variance 
pk = Covariance Matrix 
pt = Updated estimate of the error covariances 
OL = Outlier criteria 


G= Filter Gains 
err =Innovation 


dP do dO dP DP dO dO oP A DP dP cP PD oP CO BO oO CO A oP oH CO 


teins 153 

y=in(:,2); 

A=[0, 1, 0; O, O, 1; O, O, QO]; 
B=[0;0;1]; 

Cali, 04.0] 

D=0; 


pk=diag([le-1,1e-1,1e-1]); 
xk=zeros (3,size(t)); 

G=xk; 
err=zeros(1,size(t)); 


xk(1,1)=y(1); % Set initial Range to First data point 
xk(2,1) = (y(2)-y(1)/(t(2)-t(1)) % Set initial Velocity 


ce) 


% For loop to solve for each time step 


for i=2:size(t):; 


dt=t(i)-t(i-1); 3 Determine time step for each interval 


[phi,gam]=c2d(A,B,dt) ; % Calculate new for each time 
step 
xkl=phi*xk(:,I-1); % Estimate of state 
| pt=phi*pk*phi'+gam*Q*gam' ; % Propagate Std 
Deviations 
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G(:,I)=[pt*C' *inv(C*pt*C'+R)]; % Calculate Gains 
err (I)=[y(I)-C*xk1]; % Determine Innovation 


fo) ad 


Outlier Rejection 


> OL % Outlier criteria 


if abs(err(i)) 
= 0; * Ignore update due to 


err (1) 
outlying data 
end 6 Ends if loop 
xk(:,1)=xk1+G(:,1I)*err(T) ; % Update estimate of 


state 


° 
ce) 


pk=[eye(3)-G(:,1)*C]*pt; % Update covariance matrix 


psave (1,1I)=pk(1); 6 Save covariance values 


psave(2,1)=pk(2); 
psave (3,1)=pk(3) ; 
end % Ends for loop 
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